Subversion Repositories svnkaklik

/*****************************************************************************/
/*
 *  BoardController.cpp - communication with NGW100 Board controller
 *
 *      Copyright (C) 2007  Karel Hojdar
 *
 *      This program is free software; you can redistribute it and/or modify
 *      it under the terms of the GNU General Public License as published by
 *      the Free Software Foundation; either version 2 of the License, or
 *      (at your option) any later version.
 *
 *      This program is distributed in the hope that it will be useful,
 *      but WITHOUT ANY WARRANTY; without even the implied warranty of
 *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *      GNU General Public License for more details.
 *
 *
 *
 *  Revision history
 *    15.06.2007   1.0   Initial release
 */
/*****************************************************************************/

#include <iostream>

#include <getopt.h>
#include <errno.h>
#include <string.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include "linux/i2c-dev.h"
#include <sys/ioctl.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>

using namespace std;

static char* version = "BoardController, version 0.1";

static char* help = "Usage: BoardController [OPTION]\n  -I\t\tshow ID\n  -M\t\tshow model\n  -R\t\tshow revision\n  -S\t\tshow serial no.\n  -T\t\tshow temperature\n\n";

#define I2C_SLAVE       0x0703  /* Change slave address                 */
#define I2C_RDWR        0x0707  /* Combined R/W transfer (one stop only)*/

#define BC_Addr 0x0B

void DoExit(int ex)
{
        exit(ex);
}

unsigned char xfunc[5] = {0x99, 0x9A, 0x9B, 0x9E, 0x8D};
unsigned char xlen[5] = {8, 6, 1, 15, 2};

int main(int argc, char *argv[], char *envp[])
{
        char    *progname;
        int c, func = 0, Len;
        int     i2cbus = 0;
        char filename[20], Buf[64];
        int file;

        progname = strrchr(argv[0], '/');
        progname = progname ? progname + 1 : argv[0];

        while ((c = getopt (argc, argv, "IiMmRrSsTth")) != -1)
                switch (c)
                {
                case 'I':
                case 'i':
                        func = 0;
                        break;

                case 'M':
                case 'm':
                        func = 1;
                        break;

                case 'R':
                case 'r':
                        func = 2;
                        break;

                case 'S':
                case 's':
                        func = 3;
                        break;

                case 'T':
                case 't':
                        func = 4;
                        break;

                case 'h':
                        printf ("%s\n%s", version, help);
                        return 1;

                case '?':
                        printf ("Unknown option `-%c', try %s -h.\n", optopt,progname);
                        return 1;
                }

        sprintf(filename, "/dev/i2c-%d", i2cbus);
        file = open(filename, O_RDWR);

        if (file < 0)
        {
                cerr << "Could not open /dev/i2c-0." << endl;
                return -1;
        }

        if (ioctl(file, I2C_SLAVE, BC_Addr) == -1)
        {
                fprintf(stderr, "Failed to set address to 0x%02x.\n", BC_Addr);
                DoExit(-2);
        }

        int Loops = 0;

        do
        {
                Buf[0] = xfunc[func];
                if ( write(file, Buf, 1) != 1)
                {
                        fprintf(stderr, "Failed to write byte to address to 0x%02x, errno %i.\n", BC_Addr, errno);
                        DoExit(-3);
                }

                if (read(file, Buf, 1) != 1)
                {
                        fprintf(stderr, "Failed to read response length, errno %i.\n", errno);
                        DoExit(-4);
                }

                Len = Buf[0];
                if (read(file, Buf, Len) != Len)
                {
                        fprintf(stderr, "Failed to read response, errno %i.\n", errno);
                        DoExit(-5);
                }

                Loops++;
        } while (Len != xlen[func]);

        if (Loops > 1)
                fprintf(stderr, "After %i attempts got: \n", Loops);

        switch (func)
        {
                case 0:
                        Buf[Len] = 0x00;
                        fprintf(stdout, "Board ID is %s.\n", Buf);
                        break;
                case 1:
                        Buf[Len] = 0x00;
                        fprintf(stdout, "Model of the board is %s.\n", Buf);
                        break;
                case 2:
                        fprintf(stdout, "Revision of the board is 0x%02X.\n", Buf[0]);
                        break;
                case 3:
                        Buf[Len] = 0x00;
                        fprintf(stdout, "Serial number of the board is %s.\n", Buf);
                        break;
                case 4:
                        fprintf(stdout, "Temperature is %i or %i.\n", (Buf[0] << 8) + Buf[1], (Buf[1] << 8) + Buf[0]);
                        break;

        }

        close(file);

        return 0;
}