rpi_led.c File Reference

#include <stdio.h>
#include <stdlib.h>
#include <stdarg.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/mman.h>
#include <stdint.h>
#include <string.h>
#include <linux/fb.h>
#include <sys/ioctl.h>
#include "midas.h"

Include dependency graph for rpi_led.c:

Go to the source code of this file.

Classes
struct	RPI_LED_INFO

Macros
#define	FILESIZE   (64 * sizeof(uint16_t))

Functions
INT	rpi_led_init (HNDLE hkey, void **pinfo)
INT	rpi_led_exit (RPI_LED_INFO *info)
INT	rpi_led_set (RPI_LED_INFO *info, INT channel, double value)
INT	rpi_led_get (RPI_LED_INFO *info, INT channel, float *pvalue)
INT	rpi_led (INT cmd,...)

Macro Definition Documentation

FILESIZE

#define FILESIZE   (64 * sizeof(uint16_t))

Definition at line 37 of file rpi_led.c.

Function Documentation

rpi_led()

INT rpi_led	(	INT	cmd,
			...
	)

Definition at line 143 of file rpi_led.c.

{
   va_list argptr;
   HNDLE   hKey;
   INT     status, channel;
   float   *pvalue;
   double  value;
   void    *info;
 
   va_start(argptr, cmd);
   status = FE_SUCCESS;
 
   switch (cmd) {
   case CMD_INIT:
      hKey = va_arg(argptr, HNDLE);
      info = va_arg(argptr, void *);
      status = rpi_led_init(hKey, info);
      break;
 
   case CMD_EXIT:
      info = va_arg(argptr, void *);
      status = rpi_led_exit(info);
      break;
 
   case CMD_SET:
      info = va_arg(argptr, void *);
      channel = va_arg(argptr, INT);
      value = va_arg(argptr, double);
      status = rpi_led_set(info, channel, value);
      break;
 
   case CMD_GET:
      info = va_arg(argptr, void *);
      channel = va_arg(argptr, INT);
      pvalue = va_arg(argptr, float *);
      status = rpi_led_get(info, channel, pvalue);
      break;
 
   default:
      break;
   }
 
   va_end(argptr);
 
   return status;
}

Here is the call graph for this function:

rpi_led_exit()

INT rpi_led_exit

(

RPI_LED_INFO *

info

)

Definition at line 90 of file rpi_led.c.

{
   /* un-map and close */
   if (munmap(info->map, FILESIZE) == -1) {
      perror("Error un-mmapping the file");
   }
   close(info->fbfd);
 
   /* free local variables */
   free(info);
 
   return FE_SUCCESS;
}

Here is the caller graph for this function:

rpi_led_get()

INT rpi_led_get	(	RPI_LED_INFO *	info,
		INT	channel,
		float *	pvalue
	)

Definition at line 124 of file rpi_led.c.

{
   uint16_t r, g, b, rgb;
   uint32_t col;
 
   /* read value from channel */
   rgb = info->map[channel];
   r = (rgb >> 11) & 0x1F;
   g = (rgb >>  6) & 0x1F;
   b = (rgb >>  1) & 0x1F;
 
   col = (r << 16) | (g << 8) | b;
   *pvalue = (float) col;
 
   return FE_SUCCESS;
}

Here is the caller graph for this function:

rpi_led_init()

INT rpi_led_init	(	HNDLE	hkey,
		void **	pinfo
	)

Definition at line 44 of file rpi_led.c.

{
   RPI_LED_INFO *info;
   struct fb_fix_screeninfo fix_info;
 
   /* allocate info structure */
   info = calloc(1, sizeof(RPI_LED_INFO));
   *pinfo = info;
 
   /* open the led frame buffer device */
   info->fbfd = open("/dev/fb1", O_RDWR);
   if (info->fbfd == -1) {
      perror("Error (call to 'open')");
      exit(EXIT_FAILURE);
   }
 
   /* read fixed screen info for the open device */
   if (ioctl(info->fbfd, FBIOGET_FSCREENINFO, &fix_info) == -1) {
      perror("Error (call to 'ioctl')");
      close(info->fbfd);
      exit(EXIT_FAILURE);
   }
 
   /* now check the correct device has been found */
   if (strcmp(fix_info.id, "RPi-Sense FB") != 0) {
      printf("Error: RPi-Sense FB not found\n");
      close(info->fbfd);
      exit(EXIT_FAILURE);
   }
 
   /* map the led frame buffer device into memory */
   info->map = mmap(NULL, FILESIZE, PROT_READ | PROT_WRITE, MAP_SHARED, info->fbfd, 0);
   if (info->map == MAP_FAILED) {
      close(info->fbfd);
      perror("Error mmapping the file");
      exit(EXIT_FAILURE);
   }
 
   /* clear the led matrix */
   memset(info->map, 0, FILESIZE);
 
   return FE_SUCCESS;
}

Here is the caller graph for this function:

rpi_led_set()

INT rpi_led_set	(	RPI_LED_INFO *	info,
		INT	channel,
		double	value
	)

Definition at line 106 of file rpi_led.c.

{
   uint16_t r, g, b, rgb;
   uint32_t col;
 
   col = (uint32_t)value;
 
   r = ((col >> 16) & 0xFF) >> 3;
   g = ((col >>  8) & 0xFF) >> 3;
   b = ((col >>  0) & 0xFF) >> 3;
   rgb = (r << 11) | (g << 6) | (b << 1);
   info->map[channel] = rgb;
 
   return FE_SUCCESS;
}

Here is the caller graph for this function: